float32[] joint
float32[6] Pose
uint16 arm_err
uint16 sys_err
uint8 dof

